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ABSTRACT 


Two  robust  rate  control  system  designs  are  carried  out  for  a  sub¬ 
mersible  (modeled  by  the  NSRDC  2510  equations)  in  a  turn  using  the  Lineaur 
Quadratic  Gaussian  approach  with  Lo<^  Transfer  Recovery.  Separate  com¬ 
mand  channels  allow  the  submersible  to  maneuver  independently  in  - 

horizontal  and  vertical  planes;  the  vehicle  operator  controls  bearing 
and  depth  rateijthrough  a  joystick-like  device.  'The'^in  configuration 
is  the  conventional  cruciform  stern  without  differential  control. 

The  first  compensator  deal  controller  thin.  -- 

directly  controls  two  vehicle  state  variable s{  pitch  (/()  amd  thoC* 
vehicle  angular  velocity,  r,  adaout  the  z-axis.  The  other 
(therii^)-  z  controller)  controls  yaw  (or  heading)  rate  (jf^)  and  deptjura(s  ^z) 

*  directly.  However,  this  design  relies  on  lineaurized  equations  of  yaw  — 

^^and  depth  rate  to  be  enqjloyed  by  the  compensator  for  state  reconstruction. 


A  tool  for  Kalman  Filter  loop  shaping  is  developed  in  which  state 
variables  are  scaled  to  provide  good  loop  shapes  emd  then  recovered  to 
get  controllers  that  are  robust.  Both  controllers  au:e  cce^iared  on  the 
basis  of  performance  in  a  nonlinear  simulation.  A  robustness  con^eurison 
is  also  conducted. 


Based  on  limited  simulation  data, 

controller  provides  better  control  of  depth  rate  than  the  r  -  ^ 

controller.  Bearing  rate  ^rformance  is  essentially  equal  in  both  de¬ 
signs^  however,  the ^  -  z  controller  appears  less  robust  in  certain 


frequency  ranges. 
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CHAPTER  1 


ZNTRODOCTXOM 


1.1  Background 

Tha  auboiarlna  curator's  objective  is  to  maneuver  his  vehicle 
freely  in  the  ocean  enviromnent  with  respect  to  depth,  heading,  euid 
speed.  In  some  situations,  such  as  transits  and  partrols,  the  operator's 
task  is  simplified  to  maintaining  the  submarine's  depth,  heading,  and 
speed  essentially  constant.  Such  maneuvering  requirements  ue  easily 
accoeqplished  by  the  crewmembers  of  the  submersible.  On  the  other  hand, 
docking,  turning,  and  performing  evasive  maneuvers  to  avoid  navigation 
hasards  or  enemy  torpedos  are  instances  where  the  submarine's  depth, 
heading,  and  apeed  may  have  to  be  varied  suddenly.  Obviously  these 
maneuvers  must  be  carried  out  safely  and  effectively.  However,  there  aure 
many  environmental  and  design  obstacles  that  inhibit  the  operator  from 
fully  controlling  this  process.  These  irpediments  include  a  cruciform 
stern  without  differential  control;  cross-coupling  of  vhe  plaiies  of  motion 
(<hie  primarily  to  the  laurge  sail  aurea)  ,  vau:iaQ>le  hydrodynamic  forces 
(vorticity,  turbulence) ,  and  a  limited  ability  to  "see"  the  environment 
(no  windows)  . 

Largely  through  experience  atnd  familiaurity  with  the  vehicle 
dynamic  response,  the  conning  officer  leaurns  that  certain  rudder  angle/pitch 
angle  orders  will  result  in  a  certain  heading  rate  amd  depth  rate  for  a 
given  speed.  Rules  of  thumb  have  been  developed  for  ordering  the  appro¬ 
priate  amount  of  pitch  angle  to  accomplish  the  required  depth  change  and 
for  an  appropriate  amount  of  stern  plane  angle  to  offset  the  vehicle's 


tendency  to  dive  in  a  turn.  It  is  particularly  difficult  for  the  conning 
officer  to  Binultaneously  conaand  the  turn  rate  and  pitch  angle  due  to 
the  interaction  of  conplex  dynamics.  The  operator's  control  task  be- 
coBias  increasingly  difficult  as  the  severity  of  the  maneuver  Increases. 
One  would  therefore  seek  to  eliminate  much  of  the  guesswork  associated 
with  performing  these  maneuvers  by  providing  more  subbtwtial  means  of 
controlling  the  transient  dynamics  of  the  suboiarine. 

It  is  the  Intent  of  this  thesis  to  demonstrate  a  procedure  for  a 
truly  multivariable  control  system  design  that  would  provide  the  operator 
with  a  means  of  achieving  desired  suboiarine  motion  in  depth  and  heading 
through  rate  control.  The  multiple  input  -  multiple  output  (MIMO)  de¬ 
sign  methodologies  based  on  the  MIMO-LQG  formulation  of  Stein  and  Doyle 
[1]  will  form  the  theoretical  basis  of  this  thesis.  Specifically  the 
novel  MIMO-LQG/LTR  approach  proposed  by  Athans  [2]  for  model  based  com¬ 
pensators  will  be  followed  in  this  controller  design.  Inportantly, 
this  methodology  permits  the  design  of  dynamic  compensators  without  the 
need  for  full  state  feedback.  This  will  allow  the  development  of  a 
"robust"  controller  that  is  tolerant  of  modeling  errors,  nonlinearities, 
and  noise. 

1.2  Outline  of  Thesis 

Chapter  2  first  Introduces  submarine  dynamics  and  developes  the 
linear  models  that  will  be  used  for  two  different  control  system  designs 
at  30  knots.  The  last  section  of  the  chapter  will  provide  the  desired 
controller  design  ^ecifications  to  be  adhered  to  in  the  remainder  of 
this  design. 

In  Chapter  3  the  theory  that  provides  the  basis  for  the  LQG-LTR 
process  is  introduced. 

Chapter  4  is  the  design  procedure  chapter  for  the  two  controller 
designs.  A  method  to  produce  consistent  Kalman  Filter  loop  shapes  is 
developed. 


CmPTER  2 

THE  NONLINEAR  SOBMARINE  MODEL 


2.1  Introduction  to  Submersible  Modeling 

Sutamersibla  dynamics  of  motion  and  attitude  can  be  described  in  a 
variety  of  coordinate  systems.  For  the  p\urpoBa  of  developing  a  model  of 
submersible  motion/  the  equations  of  motion  are  expressed  in  the  body 
fixed  axis  because  hydrodynamic  forces  emd  inertia  are  most  readily  com¬ 
puted  in  a  ship  reference  frame.  From  the  aspect  of  ship  guidance  and 
control/  on  the  other  hand,  it  may  be  desirable  to  describe  motion,  such 
as  vehicle  course  and  depth,  in  terms  of  an  earth  reference  frame. 

General  dynamical  equations  have  been  developed  for  the  descrip¬ 
tion  ot  an  vehicle  motion.  These  represent  equalities  of  Newtonian 
force  and  moment  ei^ressions,  on  the  left  hand  side,  and  the  so  called 
dynamical  re^ranse  terms  on  the  right  hand  side: 

V 

T  ) 

\  ■  f  (dynamical  response  terms)  (2-1) 

■*  [ 

Jit  I 

The  general  form  of  the  force  expression  (Newton)  is: 


T  - 


•rr  (moroentim) 


d  ■+■ 
(mu..) 


where 


Ug  ■  iu  +  3v  +  kw 
and  the  naaent  eiqpreesion  is 

~  (angular  nomantuD)  •• 


where 

t  ^  +  Tq  +  j«r 

(The  definitions  of  u,  v,  w,  p,  q,  and  r  are  found  in  Table  2-1). 

The  subscript  G  indicates  the  origin  to  coincide  with  a  body-fixed 
coordinate  system  located  at  the  vehicle  center  of  gravity.  However,  the 
reference  point  is  seldom  taken  there  since  the  center  of  gravity  moves 
with  shifting  weights  inside  the  vehicle.  Instead,  the  coordinate  sys¬ 
tem  is  generally  taken  about  the  sxibmersible  center  of  buoyancy,  and  so 
provides  a  useful  location  for  hydrodynamic  estimates.  This  point  is  a 
function  of  vehicle  gecoetry  and  is  therefore  fixed.  The  left  hand  side 
equations  become  somewhat  more  involved  due  to  this  coordinate  system 
transformation  emd  will  not  be  discussed  further.  Details  of  these 
terms  and  slmplifcations  comnonly  used  for  ocean  vehicle  dynamics  can 
be  found  in  reference  [3]. 

The  dynamical  response  terms  of  the  right  hand  side  of  Eq.  (2-1) 
are  presented  in  Appendix  A.  These  terms  e]q[>ress  the  external  forces 
Md  moments  exerted  on  the  vehicle  by  hydrodynamic,  control  surface, 
propulsion,  and  other  effects. 

The  force  and  moment  equalities  of  Eq.  (2-1)  describe  the  six  pos¬ 
sible  degrees  of  freedom  of  the  submersible.  The  three  forces  are  in 
the  axial,  lateral,  and  normal  directions,  which  give  rise  to  motions 


Table  2-1.  Definitions  of  submarine  states  and  controls 


Submarine  States 

State  Definition 

u  B  Cco^onent  of  U  in  direction  of  x  wis 

V  ■  Coaq;>onent  of  U  in  direction  of  y  axis 

w  ■  Component  of  u  in  direction  of  z  axis 

p  >  Cooponent  of  ^  about  x  axis 

q  >  Cooponent  of  ^  about  y  axis 

r  ■  Cooponent  of  D  about  z  axis 

4  »  Angular  rotation  (roll)  about  the 

X  axis 

6  >  Angular  rotation  (pitch)  about  the 

y  axis 


Onits 

(ft/s) 

(ft/s) 

(ft/s) 

(rad/s) 

(rad/s) 

(rad/s) 

(radians) 

(radians) 


Submarine  Controls 

6r!  deflection  of  rxidder 
fis:  deflection  of  stem  plane 
6b:  deflection  of  sail  pleuies 
RPS:  shaft  revolutions  per  second 


of  surge,  svray,  and  heave  respectively.  The  three  moment  equations  pro¬ 
duce  moments  and  motion  of  roll,  pitch,  and  yaw.  Figure  2-1  shows  the 
positive  directions  of  forces,  moments,  motions,  and  control  surface 
deflections. 


2.2  The  Nonlinear  Cogputer  Model 

The  nonlinear  model  used  for  this  design  was  derived  from  the 
original  NSRDC  2510  dociinent  "Standard  Equations  of  Motion  for  suhmarHna 
Simulation"  [4]  .  These  eqxiatlons  have  since  been  improved  to  include 
crossflow  drag  and  vortex  contributions.  This  model  is  Installed  on  the 
coo®>utar  system  at  the  Charles  Stark  Draper  Laboratories.  The  nonlinear 
model  used  in  this  thesis  consists  of  8  differential  equations  to  describe 
the  submarine  dynamics.  The  six  equations  derived  from  the  force  and 
moment  equalities  account  for  the  states  u,  v,  w,  p,  q,  and  r.  The  de¬ 
pendence  of  these  states  on  hydrostatic  restoring  forces  about  the  pitch 
and  roll  eucis  and  their  kinematic  relations  result  In  two  additional 
states,  ^  and  3.  The  definitions  of  these  states  are  listed  in  Table  2-1. 

At  this  point,  it  will  suffice  to  state  that  ship  motion  in  open 
water  is  not  sensitive  to  heading  angle;  on  the  other  hand,  the  dynamics 
of  a  submersible  are  affected  by  changes  in  bxxsyant  forces  brought  ebout 
by  moderate  depth  excursions.  These  forces  were  not  accounted  for  in 
the  submarine  model  and,  hence,  depth  is  not  Included  as  a  state  in  the 
system  equations.  By  choice,  propulsion  plant  dynamics  were  excluded 
in  this  model;  the  resulting  propeller  dynamics  in  an  actual  submarine 
vary,  depending  on  the  operating  procedure  of  engineering  pl£uit  personnel 
emd  would  be  difficult  to  model.  Moreover,  the  model  in  its  cxurrent  ver¬ 
sion  does  not  include  either  the  actuator  dynamics,  or  the  actiial  angle 
rate  limits  of  the  control  surfaces.  Due  to  the  ljiQ)ortance  of  actuator 
dynamics  on  the  control  of  actual  submersibles,  they  will  be  considered 
as  part  of  the  augmented  plant  dynamics  for  this  design  in  Section  4.1. 


The  resxilting  eight  nonlinear  equations  as  used  in  the  conputer 
sinulation  with  the  definitions  of  the  hydrodynamic  coefficients  are  given 
'-Jjt  Appendix  A.  These  coefficients  are  approximated  by  direct  measurement 
on  a  full  scale  or  model  subsiarine,  or  analytically.  The  accuracy  of 
the  dynamic  reaponse  of  the  model  is  governed  to  a  large  extent  by  the 
accuracy  of  these  hydrodynamic  coefficients.  Additionally,  soiae  forces 
have  yet  to  be  modeled  mathematically,  luid  other  effects  such  as  vortex 
shedding  and  separation  effects  are  not  possible  to  include  in  a  linecur 
model  and  are  most  likely  the  weakest  point  in  the  design  model. 


The  controller  design  procedure  begins  with  the  egression  of  the 
equation  of  motion  in  linear  time  invar iemt  state  ^ace  form.  The  non¬ 
linear,  multivariable  system  that  represents  the  submarine  is  described 
bys 


l^x(t)  -  f(x(t),u(t))  (2-2) 

-  g(x(t))  (2-3) 

where 

X  is  the  state  vector 

u  is  the  control  input  vector 
^  is  the  output  vector 

These  nonlinear  equations  can  be  linearized  through  a  Taylor  series  ex¬ 
pansion  in  the  vicinity  of  a  nominal  point  (ideally  where  -r-  (x(t))  ■  0) 

at  ““ 

for  small  deviations  of  u(t}  and  x(t}  from  the  nominal  state  u  ,  x  . 

—  —  — o  — o 

From  Eq.  (2-2)  and  (2-3)  the  linearized  dynamics  are  derived  as: 
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4x(t)  a 

^x(t)  +  BAU(t) 

Ai(t)  B 

CAx{t) 

where 

Ax(t)  -  x(t)  -  X 
—  —  — o 

au(t:)  -  X(t)  - 

and 

« 

X 

o 

-  f  (x  (t)  ,  U  (t) ) 
—o  ~o 

X"X 

—  -o 

u«u 
- o 

x^(t) 

-  g(jc  (t)> 

3f(x,  u)| 

3f(x,  u) 


Ttw  paranel^rlc  llnearlMtlon  of  the  nonlinear  equations  was  accooi* 
plishad  analytically  in  the  interest  of  accuracy  for  obtaining  good  linear 
Biodals,  given  sosia  of  tha  modeling  drawbaclcs  already  mentioned.  Details 
are  given  in  Appendix  A. 

2.3.2  Nominal  Point  Selection 

A  most  isportant  step  in  the  design  process  is  to  select  a  linear 
model  that  best  describes  the  dynamics  of  the  submarine  over  the  widest 
possible  range  of  operating  condtions.  The  control  system  to  be  designed 
in  this  study  will  use  as  command  variables  emd,  therefore/  control/  in 
some  manner,  depch  and  heading  rates.  The  nominal  point  chosen  for  the 
design,  then,  will  be  taken  about  a  submarine  in  a  level  turn  (i.e., 
pitch  angle,  or  6  is  zero)  ,  since  this  attitude  of  a  submarine  is  the 
most  IDcely  qperating  condition. 

All  four  actuator  variables)  RPS,  Sr,  Sb,  and  gs  must  be  selected 
to  define  the  particular  nominal  operating  point.  The  shaft  RPS  will 
remain  at  that  required  for  30  knots  in  str2d.ght  ^dmad  motion.  The 
rudder  deflection,  Sr,  can  be  set  at  arbitrary  angles  to  cause  the  sub¬ 
marine  to  turn  at  different  rates.  A  rudder  deflection  of  (-•■)  2  degrees 
was  selected  for  this  nominal  point  design.* 

The  next  condition  involves  the  use  of  the  stern  and  bow  planes 
that  result  in  zero  pitch  while  turning.  For  reasons  outlined  in  the 
next  subsection,  the  sail  planes  will  be  "locked"  at  a  zero  deflection 
euigle  for  this  model.  With  this  constraint,  the  stern  planes  were  per¬ 
turbed  on  the  nonlinear  conputer  model  in  order  to  achieve  zero  pitch 
euigle.  The  four  actuator  variables  chosen  result  in  the  nominal  design 
point  of  Appendix  B. 

* 

The  linearization  about  (-)  2  degrees  of  rudder  would  yield  different 
system  matrices  than  that  obtained  about  (■*■}  2  degrees  of  rudder;  this 
is  primarily  attributed  to  dynamic  asymmetry  caused  by  rotation  of  the 
vehicle  propeller  (torque  reaction  and  flow). 


.1-  - 


2.3>3  output  and  Control  Variable  Formiilatlons 


Zn  this  subsection  one  will  gain  insight  into  the  appropriate 
selection  of  the  ou^ut  and  control  variables  to  accon^lish  the  proposed 
control  design.  This  will  eventually  lead  to  the  development,  it.  paral¬ 
lel,  of  two  controller  designs  based  on  two  sets  of  output  variables. 
There  will  be  sane  freedom  in  the  choice  of  control  (actuator)  variables 
as  well,  but  their  selection  will  be  based  on  a  rather  casual  approach. 


a.  Control  Methodology  Constraints 


The  Loop  Transfer  Recovery  method  for  the  class  of  Model  Based 
Coo^naators,  i^art  from  its  advantages,  places  a  very  icportant  require¬ 
ment  on  the  design  freedom  at  a  very  early  stage.  It  will  be  seen  in 
later  sections  that  the  mathematics  (singular  values  et  al.)  require  a 
squue  system,  that  is,  the  number  of  control  inputs  be  equal  to  the  number 
of  ou^ut  controlled  variables.  Stated  more  precisely: 


l(t)  -  eR“ 


u(t)  »  eR^ 


where  R  indicates  the  dimension  space  of  the  system.  So  the  requirement 


p  «  m 


(2-10) 


and  with  three  independent  control  surfaces  available 


P  <  3 


Note  that  RPS  is  not  a  control  variable  in  the  present  model. 
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b.  Control  Input  Selection 

It  was  proposed  to  have  two  "y"  ou^uts  for  the  operator  to  con¬ 
trol  through  a  "joystick-like"  device.  From  the  requirement  for  a  square 
system  p  >  m  •  2.  How,  then,  are  the  two  independent  control  inputs 
selected?  clearly  (»ie  needs  a  rudder  to  produce  motion  in  the  horizontal 
plane.  For  motion  in  the  vertical  plana,  however,  there  are  two  control 
surfaces  available,  the  stern  and  sail  planes,  which  provide  a  redundant 
control  capability.  The  stem  planes  provide  about  three  and  a  half  times 
more  force  to  affect  q  than  the  sail  planes  for  the  same  deflection  angle. 
This  can  be  seen  by  conparing  entries  B(5,  1)  and  B(5,  2}  of  the  B  matrix 
in  Table  2.2.  Realizing  the  iji^iortance  of  controlling  the  stem  planes, 
there  are  two  options  concerning  the  use  of  the  sail  planes: 

(1)  Model  the  submersible  with  the  sail  planes  locked  at  some 

angle,  ^b  ,  or; 
o 

(2)  Model  the  submersible  so  that  a  linear  relationship  exists 
bet\«ean  deflection  of  the  stem  and  sail  plwes. 

In  either  method,  there  is  effectively  only  one  independent  control  sur¬ 
face  for  vertical  motion  control. 

Table  2-2.  Model  based  B  matrix. 


State 

5s 

5b 

5r 

u 

0.29053E-01 

-0.15339E-02 

-0.10980E+00 

V 

O.OOOOOE+00 

O.OOOOOE+00 

0.21864E+01 

w 

-0.18604E+01 

-0.13578E+01 

-0.27856E-05 

P 

O.OOOOOE+00 

O.OOOOOE+00 

0.39980E-01 

q 

-0.45053E-01 

0,13042E-01 

0.91875E-06 

T 

O.OOOOOE+00 

O.OOOOOE+00 

-0.55462E-01 

« 

O.OOOOOE+00 

O.OOOOOE+00 

O.OOOOOE+00 

0 

O.OOOOOE+00 

O.OOOOOE+00 

O.OOOOOE+00 

Xn  the  first  option  ahove ,  s  constant  deflection  other  than  0 

say  not  prove  to  be  ideal  if  the  controller  is  to  operate  at  arbritrary 
pitch  conditions  in  a  turn.  Additionally,  if  several  noninal  points  were 
selected  for  gain  scheduling,  then,  when  the  controller  shifted  from  one 
set  of  gains  to  another,  a  step  change  in  6b  may  be  required.  This  change 
could  lead  to  other  probleu  and  possible  instabilities. 

In  this  design,  k  has  consequently  r?een  chosen  to  equal  earo  so 
that  6b  -  0.  This  is  consistent  with  current  fleet  subeiarine  preictice  of 
generally  not  using  the  sail  planes  to  accomplish  high-speed  maneuvers. 

The  effect  of  k  on  robustriess  and  performance  will  not  be  addressed  in 
this  thesis. 

c.  Output  Variable  Selection 

Ideally  one  would  have  the  present  systems  directly  control  the 
bearing  rate,  t^t,  and  depth  rate  z.  The  e]q>res8ions: 

^  *  (r  cos  $  +  q  sin  0)/co8  e  (2-13) 


and 


2  ■  -u  sin  6  +  V  cos  6  sin  $  +  w  cos  e  cos  ^  (2-14) 

are  nonlinear  functions  of  the  state  variables. 

To  proceed  further,  the  open-loop  time  domain  linear  model  of  the 
plant  in  Figure  2-2  is  introduced.  Here  the  ou^ut  variable,  ^(t)  ,  is 
defined  as  ^(t)  ■  Cx(t) .  The  C  matrix  will  be  an  isqportant  parameter  in 
the  design  of  the  Model  Based  Compensator.  The  C  matrix  Is  a  constant 
matrix  which  represents  the  linearization  of  (2-13)  and  (2-14)  using  (2-9) . 
Letting  y^  ■  ip  and  y^  **  z,  the  coefficients  of  the  C  matrix  eure  given  in 
Tedjle  2-3.  The  matrix  indices  (1,  2,  ...,  8)  represent  states  u,  v,  w,  p, 
g»  Z/  0,  respectively,  the  subscript  "o"  indicating  the  (value  of  the) 
state  at  the  nominal  point. 


Figure  2-2.  Linear  open- loop  plant  model. 


Table  2-3.  Linearization  of  outputs  and  z  to  obtain  the 


C(l,  5) 


sin 

o 

cos  e 

o 


C(l,  6) 


C(l,  7) 


C(l,  8) 


cos 
cos  6 

o 

-r  sin  ^  q  cos  8 
0  0^0  o 

cos  6 

o 

(r  cos  4  +  q  cos  6  )  -»•  tan  0 

o  o  o  o  o 

cos  9 


C(2, 

1) 

■ 

-  sin  0 

o 

C(2, 

2) 

- 

cos  6 

o 

sin  t 

o 

C(2, 

3) 

- 

cos  d) 

o 

cos  6 

o 

C(2, 

7) 

- 

V  cos 
o 

6  cos  (p  -  w  cos  9  sin  p 
o  o  o  o  o 

-u  cos  0  -  V  sin  9  sin  -  w  sin  6 


Y(t) 

- ► 


C  matrix, 


COB  di 


C(2,  8) 


To  determine  how  accurately  ^(t)  «  Cx(t)  represents  the  actual  ob¬ 
served  outputs  i  and  z,  the  author  has  ta)cen  all  states  of  a  maneuver  of 
a  submarine  in  a  turn  and  reconstructed  the  linear  and  nonlinear  (actual) 

•  e 

representations  of  i|)  (t)  and  z(t).  These  results  are  presented  in  Fig¬ 
ures  2-3  and  2-4.  It  is  seen  that  z,  .  bec«MS  50%  of  z  .  It 

linear  actual 

is  found  that  the  relative  deviation  between  the  linear  emd  actual  z 

decreases  as  z  .  .  increases  in  staanltuda.  ^  ,  and  are 

actual  actual  linear 

nearly  identical  over  the  full  laaneuver.  The  control  design  based  on 
these  linearized  states  will  be  referred  to  in  the  remainder  of  this 
study  as  the  -  z  controller. 

An  alternative  to  a  C  matrix  which  is  dependent  on  the  vehicle 
states  at  the  nominal  point  is  to  choose  C  such  that  its  entries  are 
independent  constants,  but  that  would  still  represent  rates  that  are 
desirable  to  control. 

Referring  to  Figure  2-4  once  more  one  can  see  that  such  a  tern 
for  tf)  exists.  The  state  r  has,  throughout  this  maneuver,  remained  within 
4%  of  made  clear  by  referring  to  (2-13)  and  noting 

that  for  nearly  all  ttuming  maneuvers,  r  »  g.  auid  the  cos  6  a  1.  To 
control  depth  rate,  one  can  revert  back  to  current  submersible  opera¬ 
tional  practice  of  commanding  pitch  angle.  This  follows  frcm  (2-14) 
where  u  >>  v,  w  so  that  z  s  -u  •  sin  0  s  -u8.  Since  forward  velocity  is 
known,  z  is  proportional  to  6  so  C  becomes: 

C(l,  6)  -  1 

C(l,  8)  «  1 

The  designed  based  on  this  C  matrix  will  be  known  as  the  r  -  6  controller. 

For  Implementation  purposes  the  exact  values  of  ^  2md  z  eure  always 
available  (observable)  for  both  the  nonlinear  models  wd  the  actual  submer¬ 
sible.  Observer  devices  to  measure  z  Include  depth  gauge  measurement.  For 
more  accurate  designs  with  less  environmental  noise,  glmballed  accelerom¬ 
eters  could  ]3e  integrated  to  provide  z.  The  Installed  rate  gyros  used 


1.0 


Z  ACTUAL 


Figure  2-3.  Reconstruction  of  actual  and  linearized  depth  rate  for 
the  sulDnerine  in  a  turn. 


for  fire  control  system  can  measure  the  substarlne ' s  true  heading  rate, 
regardless  of  hhe  vehicle  attitude.  The  r  and  6  states  can  be  measured 
with  similar  ease. 

2.4  Dynamic  Analysis 

Xn  this  svibsection  the  open-loop  poles  (eigenvalues)  and  eigen- 
vecbors  will  be  calculated,  and  the  conditions  for  controllability  and 
observability  of  linear  control  systems  will  be  presented. 

The  eigenvalvws  of  the  A  matrix  resulting  from  the  linearization 
are  shown  in  Table  2-4.  The  corresponding  normalized  eigenvectors  are 
shown  in  Figure  2-5.  It  %«ovild  appear  that  all  modes  eure  dominated  by 
the  velocity  states  u,  v,  and  w.  A  different  picture  results  when  the 
values  of  the  eigenvectors  involving  angle  and  angle  rata  states  ^u:e 
scaled  from  radians  to  degrees  and  the  velocities  u,  v,  and  w  remain 
in  feet/second.  Although  the  choice  of  units  was  somewhat  eurbitrary, 
the  scaled  and  normalized  eigenvectors  of  Figure  2-6  secun  to  provide  a 
clearer  picture  of  the  state  contribution  to  the  system  modes.  The  com¬ 
plex  pole,  -0.19  t  0.321,  is  associated  with  the  natural  roll  behavior  of 
the  submarine.  The  slowest  pole,  -0.013,  is  primarily  a  pitch  mode.  The 
zeroes  of  the  system  will  be  discxissed  in  Chapter  4,  after  the  addition  of 
augmented  dynamics. 

TeU^le  2-4.  Complex  eigenvalues  of  A. 


-0.190874E-K)0 
-0 . 190874E+00 
-0.487435E+00 
-0.443184E-K>0 
-0.978560E-01 
-0.432890E-01 
-0.591569E-01 
-0.133116E-01 


0.320975  I 
-0.320975  I 
0.000000  I 
0.000000  1 
0.000000  1 
0.000000  I 
0,000000  1 
0.000000  I 
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C«itrollabllity  and  obaervablllty  prap«rtlea  need  to  be  established 
to  proceed  further  with  the  control  eyetem  design.  Controlability  is  en¬ 
sured  only  if  the  matrix 

[B,  M,  ...»  (2-15) 

has  rank  n.  Sixdlarly,  observability  is  guaranteed  if  the  matrix 


has  rank  n. 

A  simpler,  but  more  conservative  nvathod  than  (2-15)  and  (2-16) 
above  will  be  used  to  establish  controllability  and  observability.  Since 
eigenvalues  of  A  are  distinct  and  nonzero,  one  can  find  the  ccmplex  modal 
matrix,  T,  whose  colvnns  are  the  distinct  eigenvectors,  v^.  For  any  set 
of  scalars  c^  (not  all  zero) : 


E  C  V  ■  0 

i  ^ 

Implies  that  T  Is  a  nonsingular  matrix.  Then  the  state  equation  can  be 
written  In  the  modal  domain  [5] : 


d  -1  -1_ 

~  X*  “  T  ATx*  +  T  Bu 

Z  “  £  2,  ii* 
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The  oontrollabiUty  and  observability  conditions  are  then  store  than 
satisfied  by  observing  that  the  real  puts  of  the  colvBnns  of  T  ^  and 
tte  rows  CT  have  no  zeros.  This  was  found  to  be  the  case  for  both  the 

e  e 

r  -  6  and  z  -  ii  systems. 

2.5  Perfomanoe  Specifications 

Perfomance  ^eciflcations  outlined  in  this  section  are  not  all 
encoe^asslng  and  stay  not  coincide  with  established  Navy  specifications 
for  sulaetersible  control.  The  performance  requirements  as  stated  here 
are  isainly  driven  by  the  intuitive  engineering  approach  to  obtain  good 
ccoBiund  following,  speed  of  re^onee,  robustness,  and  disturbance  re¬ 
jection  with  due  reqiect  to  the  natural  dynamics  of  the  vehicle  as 
they  emerge  from  the  available  model.  These  performance  requirements 
(guidelines)  will  be  accomplished  through  loopshaping  techniques  to  be 
discussed  in  Chapter  3. 

Since  there  are  no  natural  integrator  states  (the  8  x  8  A  matrix 
is  nonsingular)  ,  elimination  of  steady- state  error  to  step  Inputs  is  not 
possible.  Good  coonaand  following  and  elimination  of  steady-state  errors 
will  be  obtained  through  the  use  of  integrators  in  the  command  variable 
channel.  Although  an  actual  rata  control  system  may  also  experience 
ramp- like  commands  from  the  "  joy- stick” ,  the  ccmmand  inputs  here  are 
closer  to  being  a  step  due  to  the  large  time  constants  of  the  system. 
Therefore,  the  system  described  in  this  thesis  will  not  be  designed  to 
meet  type-2  specifications. 

The  open- loop  dynamic  simulation  demonstrates  that  achievable 
vehicle  settling  times  due  to  deflections  of  control  surfaces  are  a 
function  of  the  vehicle  speed.  For  a  submersible  at  a  speed  of  30  knots, 
settling  time  of  50  -  60  seconds  are  achievable.  When  settling  is  de¬ 
fined  to  occur  in  4  or  5  time  constants,  the  resulting  minimian  band¬ 
width  requirements  for  crossover  are  0.07  to  0.1  radians/second.  From 
the  performance  aspect  it  is  desirable  to  have  all  ch^umels  crossover 
at  roughly  the  same  frequency. 
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On  tba  frequancy  slder  one  must  be  able  to  reject  noise  and 

possible  nodeling  errors.  Noise  sources  generally  originate  from  the 
enviroment  (trtae  sensor  readings)  or  from  the  sensor  itself.  Sensor 
noise  typically  comas  at  a  higher  frequency  than  the  system  bandwidth  and 
^  should  not  affect  ship  dynamics  since  ship  eigenvalues  will  typically,  lie 

in  the  lower  frequency  band.  It  is  desired  that  the  ship  actuators  do 
not  respond  to  nomed.  environsiental  disturbances  that  nay  cause  unnces- 
sary  actuator  motion.  Of  concern  here  is  the  effect  of  the  submersible 
operating  close  to  the  surface,  but  not  so  close  as  to  be  in  the  danger 
of  broaching/  and  experiencing  excitations  of  surface  waves.  Based  on 
Figure  2-7  [61 ,  it  is  apparent  that  a  typical  wave  spectrin  has  a  fre¬ 
quency  range  between  0.2  and  2  radians/second.  The  excitation  or  driving 
frequency  the  subeiarlne  experiences  will  be 

0)  -<  01  -t-  ku  cos  (4) 

e 

where 

■>  frequency  of  encounter 

u  >  wave  spectrum  frequency 
2 

k  >  bi  /g  ■  wave  number  in  deep  water 
u  a  ship  forward  velocity 
4  *  ship  head  relative  to  sea  direction 

then,  based  on  an  estimated  meuc  ship  speed  of  35  knots  (60  fps) : 

(1)  max  ■  9.5  rad/s  (in  head  seas) 

e 

(jj  min  0.13  rad/s  (in  following  seas) 

e 


c 


35 


r' 

i 

u 


o.j  0.4  o.»  0.0  1.0  ,r.d/..C) 

Figure  207.  Typical  form  of  a  wave  q^ctrim 
containing  ?-#eIl  (from  Ref.  [6]). 

and  therefore  at  any  vehicle  speed,  35  knots  or  less,  all  other  ship 

headings  relative  to  the  sea  will  be  contained  within  u  max  >0)  >  uj  min. 

e  e  e 

The  proposed  controller  will,  than,  be  able  to  meet  these  minim\an 
criteria  with  the  suggested  beuidwidth,  at  least  in  the  region  where  linear 
behavior  dominates  the  vehicle  dynamics. 


CHAPTER  3 


CONTROL  SYSTEM  DESIOl  METHODOIOGY 


3 . 1  RobiiatnesB 

3.1.1  Robustness  Design  Consldarationa 

Control  system  design  frequently  Involves  the  tradeoff  of  realizing 
high  performance  while  preserving  good  consnand  following,  distvorbance 
rejection,  and  system  stability.  The  achievement  of  high  performance  is 
pointless  if  the  control  system  becomes  unstable  as  a  result.  This  is 
partic\ilarly  ixapottant  in  the  present  design.  Overall  system  instability 
could  cause  the  submersible,  in  some  instances,  to  exceed  its  safe  operating 
depth  or  ground  itself,  resulting  in  the  lost  of  the  submarine  and  its  crew. 
The  multivariable  methods  used  to  assure  stability  and  robustness  will  be 
reviewed  next. 

Singular  value  analysis  has  evolved  as  a  reliable  method  to  evaluate 
system  stability  and  robustness  in  the  presence  of  unstructured  uncertainty. 
The  singular  values  of  an  (n  ><  n)  complex  matrix  A  derived  from  the  spectral 
norm  | IAII2  defined  by: 

-  vX^(a”a)  i  -  1,  2,  ...,  n 

where 

A  is  the  complex  conjugate  transpose  of  A 
is  the  1th  eigenvalue  operator 
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in  modaling  tha  syataa  dynamics  and  therefore  will  be  used  in  this  model. 
Furthermore,  a  prcnnultiplicative  error  of  the  loop  transfer  function  will 
be  defined  to  reflect  errors  at  the  plant  output,  as  shcnm  in  Figure  3-3. 
In  this  instance 


L(s)  -  I  +  B(s) 


so  that  the  premultlplicative  error,  is  found  to  be 


E  (s) 
-pre 


-  IG(3)  -  G(a)]G  *(s) 


(3-1) 


Figure  3-3.  MIMO  feedback  configuration  reflecting 
premultlplicative  error  at  plant  output. 


From  the  Fundamental  Robustness  Theorem  and  the  Theorem  for  Robust¬ 
ness  for  Multiplicative  Errors  (see  Lehtomaki  [7]),  for  guaranteed  stabil¬ 
ity,  the  following  Inequality  must  hold: 


(3-2) 


‘ 


If  the  inequality  (3-2)  above  is  not  true,  it  does  not  necesseurily 
inply  the  system  must  be  unstable.  Singular  value  analysis  does  not  take 
into  account  the  actual  direction  of  the  perturbation  matrix  that  may 
cause  a  system  to  become  singular;  hence  the  system  may  actually  be  more 
robust  than  singular  value  analysis  may  indicate.  Therefore  the  inequality 
(3-2)  above  is  conservative. 

3.1.2  Scaling 

Scaling  is  a  method  of  treighting  the  physical  units  of  a  system, 
through  an  appropriate  transformation,  so  that  the  numerical  values  of 
the  veurlables  become  equally  significant.  Scaling  and  its  effect  in 
designing  robust  multivauriable  control  lystems  has  been  resently  dis¬ 
cussed  by  Kappos  (9]  and  Boettcher  (8).  ^parently,  scaling  does  in 
fact  change  the  singul2u:  value  magnitudes,  but  it  may  not  necessarily 
change  the  robustness  of  the  system  [8].  Ostensibly,  not  all  effects  of 
scaling  are  understood  at  present. 

A  systematic  method  does  not  yet  exist  to  obtain  optimal  scaling. 
Kappos  [9]  selects  a  scaling  matrix  based  on  the  expected  nominal  departure 
(error)  of  the  output.  Kwakernaack  [10],  although  not  specifically  addres¬ 
sing  the  robustness  issue,  similarly  suggests  weighting  the  states  by 
their  tolerable  error,  i.e.,  a  deviation  of  10  ft/s  in  velocity  may  be 
as  bad  as  a  deviation  of  0.2  radians  in  pitch,  and  then  base  the  weighting 
on  the  ratio  of  the  tolerable  errors.  In  this  thesis  the  author  presents 
a  method  that  allows  the  system  to  scale  itself  through  loop  shaping 
techniques.  This  procedure  will  be  presented  in  Chapter  4. 

A  scaling  transformation  to  tramsform  state  vectors  must  be  diagonal 
and  positive  to  preserve  the  system  eigenvalues.  Briefly,  if  2md  x 

are  the  original  state  vectors,  and  u' ,  ,  and  x’  are  a  set  of  scaled 

vectors,  then; 
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consequently  for  a  system  of  the  original  form: 


coetes 


similarly,  scaling  (s) ,  the  premultlpllcatlve  error  defined  In  Eq.  (3-1) 
one  obtains 


E'  (s) 


E(s)S 


(3-8) 


Finally,  a  useful  property  of  the  scaling  transformation  will  be 
developed  next.  TaXe  the  Qwclal  case  of  Eq.  (3-7)  where  Is  the 
Identity  matrix  so  that 


G'  (8) 


(3-9) 


By  taking  the  coa^lex  conjugate  tran^Jose  of  Eq.  (3-9)  above: 

£•“(8)  -  ^(8)  (3-10) 

Prom  Eq.  (3-9)  and  (3-10)  then 

G'(8)G'"(8)  -  G(8)g"(8)£'“  (3-11) 

and,  applying  the  two-norm  iiqpliea 

I|g'(«)||2  -  l!s^^G(s)l|2  (3-12) 


so  that 


Note  that  S  Is  not  a  function  of  s.  Through  matrix  multiplication, 


the  diagonal  entries  of 


of  the  matrix  independently  multiply 


the  rows  of  G(s).  Knowing  the  following  relation  to  hold 


OA  -  a 


where  o  is  a  scalar. 


it  follows  that  the  i  singular  values  of  |  |^  £(b)||  satisfy 


a^(G’(s)l  -  o^tG(s)l 


(3-14) 


Hence,  it  is  seen  that  the  transfonnation  matrix  directly  effects  the 


magnitude  of  the  singular  values  of  the  original  transfer  matrix.  Equation 
(3-14)  will  be  an  important  tool  that  will  be  employed  in  Chapter  4  to  help 
select  appropriate  scaling  trainsformations  to  2u:hieve  consistent  loop 
shaping. 


The  Hodel  Based  Compensator  (KBC)  has  evolved  from  the  optimal  esti¬ 
mation  theory  (Kalman  Filter)  and  optimal  control  theory  (Linear-Quadratic 
FeedbacK) .  The  concepts  presented  here  can  be  found  in  more  complete  form 
in  references  [10]  and  [11]  .  The  form  of  the  conqpensator  used  in  this 
design  together  with  the  state  definitions  is  shown  in  Figure  3-4  with 
the  plant  and  compensator  dynamics  repret«nted  separately.  The  trauiafer 
function  definitions  used  in  the  remainder  of  this  paper  will  be  based  on 
Figure  3-4. 


Referring  to  Figure  3-4,  the  error  £(t)  is  the  input  and  u(t)  is 
the  output  of  the  compensator;  the  overall  MBC  transfer  matrix  is  defined 


u(8)  «  K(8)  e(s) 


W] 


where 


K(8)  -  G(ai  -  A  +  BG  +  ^)  H 


(3-15) 


Also,  it  is  easily  shown  that  the  overall  closed-loop  tremsfer  function, 

trrr  (•) 

-CL 

^ (s)  -  det(fll  -  A  +  BG)  det(8l  -  A  +  HC)  (3-16) 

— —  — • 

It  follows  that  the  requirements  for  stability  of  the  system  are: 


Re  X^[A  -  ^]  <0 


(3-17) 


Re  A^tA  -  HC)  <  0 


(3-18) 


which  are  the  poles  of  the  compensator. 

The  conditions  for  ensxiring  a  stable  cooq^nsator  are  now  postulated. 
From  linear  system  theory,  if  the  pair  [A,  B)  is  controllable  (or  stablliz- 
able)  ,  than  there  exists  at  least  one  feedback  gain  matrix  G  to  ensure  that 
all  closed- loop  poles  of  [A  -  BG)  are  in  the  left  half  s-plane.  G  is 
given  by 


G  -  r”^  BK 


(3-19) 


where  K  solves  the  Control  Algebraic  Ricatti  Equation  (CARE) 


0  -  -  A^K  -  2  +  KBR~^B^K 


(3-20) 
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LDcttwise,  if  the  pair  [A,  C]  la  controllable  (or  datactable) ,  then 
there  exists  at  least  one  ou^ut  gain  matrix  H  such  that  all  closed-loop 
poles  are  in  the  left  half  a-plane.  The  matrix  H  is  given  by: 

T  -1 

H  -  E  C  (3-21) 

where  ^  solves  the  Filter  Algebraic  Ricatti  Equation  (FARE) : 

0  -  ^  +  A^E  +  (3-22) 

3.3  Loop-Transfer  Recovery 

In  the  sequel,  sane  properties  of  the  Kalman  Filter  that  forms 
the  basis  for  the  Loop-Transfer  Recovery  (LTR)  method  to  be  employed  in 
this  design  will  be  discussed.  The  Kalman  Filter  loop  transfer  function, 
G^,  is  taken  at  point  1  on  Figure  3-4.  The  resulting  loop-transfer  func¬ 
tion  is  defined 


-  C(8l  -  A)”^  H  (3-23) 

One  can  also  define  the  filter  open-loop  transfer  function  as 

SfOL  ■  ‘ 

where  L  is  a  free  design  paurameter  that  is  chosen  to  give  desirable 

singular  values  to  inset  the  performance  amd  robustness  specifications. 

The  Kalmam  Filter  Domain  Equality 

has  loeen  derived  from  Eq.  (3-22)  ,  (3-23)  ,  amd  (3-24)  where  the  substitu¬ 
tion 


!'  ■ 

u- 


f,  ■ 
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^  for  n  >  0 

has  bean  made  in  the  FAKE  Eq.  (3-22) . 

As 

U  -►  0 

in  Eq.  (3-25) ,  it  follows  directly  from  the  definition  of  singular  values 
^hat 

0-26) 

which  is  valid  for  low  frequency  range,  and  represents  the  recovery  of  the 

loop  shapes  of  the  G  from  G_.  .  The  value  of  u  is  also  a  frea-design 
— lur  — twIj 

paLraaeter . 

The  Rwakernuc)c  Loop  Transfer  Recovery  process  (see  e.g. ,  Doyle, 
Stein  [1],  Kwakemaack  [12])  is  descrUsed  next,  in  which  the  shapes  of 
the  Kalman  Filter  singular  values  of  Eq.  (3-26)  eure  recovered  in  tlie  loop- 
transfer  matrix  of  the  Model  Based  Coo^nsator.  The  loop-tremsfer  matrix 
of  Figure  3-4  is  given  by 

'T  -  G(s)  K(8)  -  C(s2  -  A)”^  BGCsl  “  A  +  BG  +  HC)"^  H 

(3-27) 


The  LTR  method  sets 


In  the.  CARE  Eq.  (3-20).  Then,  as 


q  «D 


the  corresponding  ^  In  Bq.  (3-27)  becones  'large*  so  that  Eq.  (3-27) 

becomes 


T  a  C(8l  -  A)“^  H 

OD 


end)  consequently 


o^(C(ja>I  -  A)"^  H] 


(3-28) 


(3-29) 


for  low  frequencies. 

The  LTR  method  is  giiarantaed  to  work  in  the  open- loop  system  is 
minimum  phase.  For  non-minimus  phase  systems  there  is  no  such  guarantee, 
although  some  recovery  of  performance  and  robustness  properties  are 
expected  as  ttm  non-minimum  phase  zeros  move  further  away  from  the  desired 
operating  bandwidth  (see  [13]). 

Robustness  Theorems 

The  following  robustness  properties  can  be  derived  from  the  Kalman 
Filter  Equality  (3-25)  wd  are  required. for  system  robustness: 

which  follows  directly  from  the  KFE;  and 
'=>  "rnln'i* 

which  has  been  proved  by  Kappos  (9). 
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CIO^TER  4 


CXMPBNSATOR  DRSIGM  PROCEDURE 


4.1  Auqnantcd  Dynamics 

Augnanting  the  dynaalcs  of  the  svihoeraible  control  system  serves  a 
dual  purpoae.  One  Is  to  model  the  actuator  dynamics  to  make  the  model  as 
accurate  as  possible,  eu\d  achieve  desirable  roll-off  at  crossover  for 
robustness.  The  other  is  to  include  integrators  to  causa  the  compensator 
to  behave  as  a  type-1  system,  which  vrill  permit  the  submersible  to  achieve 
zero  steady-state  error  to  step  inputs  and  disturbances  (i.e.,  good  consoand 
following) .  The  result  will  be  to  increase  the  order  of  the  sytem  by  four 
in  the  present  two-input  design. 

A  block  diagram  of  the.  augmented  model  appears  in  Figure  4-1.  It 

is  seen  that  the  aucpnented  dynamics  have  been  placed  in  the  command  channel. 

u^  is  the  true  commanded  input  (a  physical  varieible) ,  u^^^,  the  output  of 

the  augmented  dynamics,  is  not.  The  mathematics  of  the  augmented  states 

will  be  manipulated  in  such  a  way  as  to  provide  a  means  to  achieve  the 

desired  loqp  shapes  of  G _ . 

~rOL 

Actuator  Dynamics 

The  complete  actviator  dynamics  are  governed  by  their  mass  proper¬ 
ties  of  the  rudder  and  planes,  and  angle  rate  limits  inposed  by  the 
electro- hydraulic  servomechanioms  that  position  them.  Since  the  rate 
limits  are  highly  nonlinear,  they  will  not  be  modeled  per  se.  Instead, 
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AUGMENTED  DYNAMICS 


EXISTING  PLANT 


Figure  4-1.  Augmented  dynamics  placed  in  command  variable 
channel  of  plant. 

the  conpensator  will  be  designed  so  that  the  rudder  and  stern  planes  are 
never  driven  past  their  rate  limits  of  7  and  6  degrees/second  respectively, 
nor  past  their  niaxlmuD  allowable  deflection  wgle. 

The  actuator  dynamics  of  tlua  rudder  are  represented  by  a  second- 
order  system.  These  are  given  for  the  stern  planes  as 

(»)^  *  1.37 

5  -0.9 


emd  for  the  rudder  as 


w.  -  1.09 

d 

5  -  0.9 

as  C  approaches  unity,  a  secoi  i-order  system  begins  to  lose  its  oscillatory 
characteristics  euid  behavior  tends  toward  a  first-order  system.  Since  this 
is  very  nearly  an  overdao^d  system,  the  actuators  will  be  modeled  as  a 
first-order  system.  By  Ogata  [15]  the  rise  time  for  a  second-order  system 
is  given  by 


Figure  4-2.  Stem  plane  coimnand  channel  with 
augmented  dynamics. 


Figure  4-3.  Rudder  cosmand  channel  with 
augmented  dynamics. 


These  dynamics  ars  introduced  to  the  8th  order  state  space  repre¬ 
sentation  to  produce  a  12th  order  system.  To  get  it  in  a  form  for  further 
design  manipulation  a  new  state  vector  is  defined 


where  x'  Is  the  unaugmented  8th  order  system  augmented  with  the  two  command 
chaurinel  actuator  time  lag  states  and  are  the  two  integrator  states  in 
the  command  channel.  The  augmented  system  can  be  written  as 


and  aijq>lifylng  let 


This  form  of  s^te  space  equations  will  be  used  in  Section 
suitable  loop-shaping  algorithns.  The  A  emd  B  matrices  of 
system  are  found  in  /.ppendlx  B. 


Augmented  System  Dynamics 


+  Bu 


(4-2) 

4.2  to  derive 
the  augmented 


The  four  additional  states  add  two  poles  at  the  origin  and  one  each 

at  -1.6  emd  -2.0  to  those  already  listed  in  Table  2-4.  The  multivariedsle 

•  • 

zeros  for  both  the  r  -  0  and  -  z  system  are  listed  in  Table  4-1.  Note 


Figure  4-4.  Unaugmanted  open-loop  plant;  r  -  6  system; 
singular  values  vs  frequency. 
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Figure  4**6.  Augmented  open- loop  plant;  r  -  6  system; 
singulu  values  vs  frequency. 


Table  4^1.  Au^&ented  system  zeros  (finite). 


r  -  6  System  Zeros: 


MismtK  sssL  ima  ewiwe  FstaunrY 

t  >i.S7es4«un>«x 

i  ot.MrAteuot-oi 

s  -i.sszoeoMXE-oi  -i.oeoezMSSE-oi  s.zMm»9R*oi  t.snrsszsH-oi 


il)  »  z  System  Zeros; 


fwa  B£Ak  lots  PV»1NB  gMMHCY 

1  >S.7M47*18tt>02 

2  •2.M779M47E<>ei 
>  -Z.US2171SM>fll 

S  -l.Sli4i02Me-01  -S.0SS29M9SE-C1  S.0«UB7471EH>1  3.5aX2He64t>01 
i  7.20MSni7E-01 


«  • 

that  Vf  -  z  syetem  has  a  non>minlmun  phase  zero  at  0.7,  the  existence  of 
which  Is  most  likely  due  to  the  relationship  between  the  pitch  (6)  and 
heave  (w)  states  in  z.  Zt  is  pointed  out  here  that  both  the  actuator 
dynamics  and  the  non-minimvm  phase  zero  are  beyond  the  desired  system 
bandwidth  of  0.1.  Therefore,  they  are  not  expected  to  effect  the  design 
appreciably.  However,  the  actuators  have  been  incorporated  in  the  design, 
to  provide  additional  roll-off  at  higher  frequencies. 

Open-Loop  Transfer  Function 

The  singular  values  of  the  unaugmented  (8th  order)  systems  eure 

plotted  in  Figure  4-4  and  4-5.  In  both  of  these  figures,  the  minimum 

singular  values  correspond  primarily  to  the  turn  related  outputs,  i/  and  r. 

The  beginning  of  gain  roll-off  corresponds  to  a  system  pole  as  it  would 

in  a  Bode  plot.  The  maximm  8ingi;il6Lr  values  in  both  figures  begin  to 
-2 

roll-off  at  10  radiauts/s,  which  corresponds  to  ttie  pole  at  -0.013 
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Figure  4-7.  Augnentad  open- loop  plemt;  -  z  system; 
singular  values  vs  frequency. 


(the  6  -  w  dools^ated  eigenvector  of  Figure  2-6) .  The  minimum  singular 
values  start  to  roll-off  at  10  ^  radlans/s,  which  relates  to  the  pole  at 
-0.097.  This  pole  corresponds  to  the  "slowest"  eigenvector  to  first  con¬ 
tain  coiqponents  of  the  r  state.  The  bandwidth  corresponding  to  the  r  emd 

e 

i|(  ou^uts  is  nearly  an  order  of  magnitude  greater  than  the  z  aAd  6  outputs. 

The  open- loop  singular  values  of  the  augmented  (12th  order)  system 
are  shown  in  Pigxire  4-6  and  4-7.  The  Integrators  in  the  ccomand  channel 
correapond  to  the  slope  of  1/s  or  20  dB/decade  at  low  frequency.  Also  note 
that  the  minimtsa  singuleir  values  of  both  figures  are  nearly  identical  over 
the  chosen  frequency  range.  It  will  be  shown  that  either  choice  of  r  or 
as  am  ou^ut  variable  will  restilt  in  neaurly  equal  performance  in  the  con¬ 
troller  design. 

4.2  Iioop-Shaminq  Techniques 

In  Chapter  3  the  notion  of  the  free-design  paurameter  u  and  matrix  L 
was  introduced  to  provide  a  means  of  sharping  the  singulaur  values  to  meet 
the  design  specifications,  in  this  section,  the  author  will  derive  a  pro¬ 
cedure  to  obtain  tied  together  throughout  the  desired 

operating  bandwidth,  and  will  eventually  result  in  a  deslradile  tight  cross 
pattern  of  the  Model  Based  Compensator  loop  tramsfer  function  T(s). 

The  filter  open-loop  transfer  function  is  given  in  Eq.  (3-24)  as 


Let  L  be  of  the  form 


where 

Is  all  states  excluding  the  integrator  states 
is  the  integrator  states 

and,  starting  with  the  full  augnented  systan  dynasties  in  the  state  space 
form  as  developed  in  Eq.  (4-'2) 


one  obtains 


Taking  the  block  inverse 


si  -  A) 


Mow  for  low  frequencies 


B  0 
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C(sl  -  A)  La 


^  J  1^2 


.-1 


-10-10— I  8 


Hence,  for  small  s,  Eq.  (4-4)  further  becomes 


,  “  c  aT^  B  L^ 

»  /  .  .  >  “1  .  ~  —10  — T  —2 

C(8l  -  A)  La  - 


By  Eq.  (3-22) 


-1 


-  £(»I-A)  k 


To  tie  the  singular  values  together,  it  is  desirable  to  set 

I 


^L  “  8 


and,  consequently,  obtain  from  (4-5) 


-1 


1  -£AoA^ 


Finally,  solving  for  L 


The  ilependance  of  the  low  frequency  singular  values  should  be  clear? 
^  drives  the  controller  through  the  Integrator  states. 

An  analogous  method  was  used  to  the  high  frequency  singular  values 
together.  From  Eq.  (4-3)  it  follows  that 

T  T  -1 

-  CNCC  )  (4-8) 


4.3  Model  Based  Compensator  Design 

Equations  (4-7)  and  (4-6)  were  applied  to  both  designs.  Figures 
4-6  and  A- 9  are  the  plots  of  the  shaped  <7.(G„, )  which  show  how  the 
singular  values  are  ti«  .  together  at  low  and  high  frequencies.  By  varying 
the  design  parameter  u,  these  singular  values  can  be  shifted  vp  or  down. 
However,  neither  plot  would  result  in  a  tight  crossover  pattern  at  the 
desired  crossover  firequency  of  0.08  radiems/s.  It  is  through  the  use  of 
the  scaling  transformation  properties  developed  in  Eq.  (3-14)  that  the 
shapes  of  these  singular  values  approach  the  desired  shapes  for  good  com¬ 
mand  following,  disturbance -rejection,  and  crossover  frequency  specifications 

Referring  to  Figure  4-8  it  is  proposed  that  the  minimum  singuleu: 
value,  r,  be  scaled  to  match  the  maxlmw  singulu  value,  6,  at  its  greatest 
separation.  This  point  occurs  at  a  separation  of  about  24  dB,  which  Is 
eqtrivalent  to  a  ratio  between  the  values  of  r  and  6  of  16,  at  a  frequency 
of  0.02  radians /s.  For  nunerical  convenience,  r  will  be  scaled  by  a  factor 
of  10  (versus  16).  This  means  that  r  will  be  observed  in  "tens  of  radians, 
while  the  output  9  continues  to  have  units  of  radians. 

A  similar  spproach  is  applied  to  figure  4-9.  In  this  case,  the  maxi- 
muB  separation  approaches  4  orders  of  magnitude.  For  nisnarlcal  convenience, 
ifi  will  be  sclaed  vp  by  a  factor  of  10  (the  same  factor  used  for  r  above)  , 
where  z  is  scaled  down  by  0.01. 


G  HRSNITUDE) 


n^EOUENCY  (RRD/SEC) 


Figure  4-9.  Shaped  and ^unsealed  filter  open- loop  transfer 
function!  ij)  -  z  system;  singulau:  values  vs 
frequency . 
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Figiure  4-12.  Shaped  and  scaled  filter  open- loop  transfer 
function;  r  -  0  system;  singulju:  values  vs 
frequency. 
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Figure  4-13.  Shaped  emd^ scaled  filter  open- loop  transfer 
function;  ^  -  z  system;  singuleu:  values  vs 
frequency. 
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«nd  solving  for  y  thsn 


-  to 

aax  o 


-2 


where  6  le  the  (maxlmun)  desired  crossover  frequency.  The  value  of 

o  ■  ^  ^ 

obtained  were  126  and  144  respectively,  for  the  r  -  6  and  41  ~  z  controller, 
using  a  Baxiaus  crossover  frequency  of  0.09  radlans/s. 

With  the  design  parasietera,  y,  L,  and  thus  detenalned,  the  design 
can  proceed  with  the  application  of  the  FARE  Eq.  (3-22)  and  (3-21)  to 
calculate  the  Kalman  Filter  gain  matrix  H.  The  singulitr  values  of 
are  plotted  in  Figures  4-14  and  4-15.  The  loop  shapes  have  been  re¬ 
covered  in  both  cases  with  crossover  in  the  remge  of  0.07  to  0.09  raidians/s. 

Finally,  the  controller  gain  matrix,  K  is  calculated  by  the  CARE 
Eq.  (3-20)  and  (3-19) .  The  only  free  design  parameter  to  choose  is  q,  the 
control  weighting  index.  Generally,  to  prevent  control  saturation  from 
high  gain  of  K,  it  makes  sense  to  choose  q  as  small  as  possible  and  still 
meet  the  design  specifications.  In  both  controller  designs,  when  q  was  set 
equal  to  10,  a  crossover  of  0.07S  radians/s  was  obtained  by  the  singular 
values  of  the  loop-transfer  matrix,  T(s) .  These  axe  plotted  in  figures  4-16 
and  4-17.  Note  the  roll-off  at  crossover  is  20  dB/decade,  as  expected, 
and  that  Eq.  (3-27)  fails  to  hold  at  frequencies  above  0.7  radian/s. 

Robustness 

The  singular  value  plots  of  the  Kalman  Filter  return  difference  and 
Kalman  Filter  inverse  return  difference  matrices  are  shown  in  Figure  4-18 
and  4-19  for  the  r  -  6  system,  and  in  Figure  4-20  and  4-21  for  the  'p  -  z 
system.  The  robustness  criteria  set  forth  in  Eq.  (3-30)  euid  (3-31)  have 
been  met. 

A  discussion  of  the  robustness  of  the  loop-tremsfer  matrix  according 


to  Eq.  (3-2)  is  given  in  Chapter  5. 
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Figure  4-18.  Kalman  filter  return  difference;  r  -  6  system; 
singulou:  values  vs  frequency. 
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CHAPTER  5 


MODEL  BASED  C0MPQ18AT0R  BVALOATIOH 


5.1  Ca«MP«n»ator  Design  rmpl«n>ntatlon 

In  this  section*  the  performance  of  both  the  r  -  6  wd  ^  -  z  con- 
.trollezs  will  be  tested  on  the  nonlinear  submarine  simulation  to  see  how 
closely  the  performance  specifications  are  met  and  to  check  for  instabili* 
ties.  Mote  that  the  linear  plant  dynamics  G(s)  presented  in  the  feedback 
configuration  of  Figure  3-4  has  been  replaced  by  the  nonlinear  plant 
dynaaaics  of  the  simulation.  TlM  states  at  point  2  of  Figure  3.4  eure 
therefore  the  actual  measure  of  output  variables.  This  means  that  the 
error  vector,  e(t)  ,  at  the  input  of  the  Modal  Based  Con^iensator  is  always 
the  tr\M  difference  between  the  coamuuided  input  emd  the  output  variables. 

In  order  to  avoid  tha  additional  confutations  required  to  tramsform 
the  ou^ut  variables  back  to  their  original  units,  the  output  veuriables  aure 
hamdled  in  their  scaled  form.  To  maintain  a  properly  scaled  error  vector, 
e(t)  ,  the  true  outf  ut  vaurlables  and  the  conmamd  input  veuriables,  £(t}  ,  aure 
multiplied  by  the  appropriate  scaling  transformation.  Figure  5-1  illustrates 
how  thn  modal  based  confsnsator  feedback  configuration  for  this  design  imple¬ 
mentation  is  modified  by  scaling. 

5.2  Evaluation  of  Output  Varied? le  selection 

Comparison  of  the  two  system  performances  will  be  accosf  lished  in  this 
section  to  determine  which  rate  control  system  provides  better  performauice 
and  robustness  chair acteri sties.  The  performamce  evaluation  will  be  based 


Figure  5-1.  Modifications  of  the  MBC  feedback  configured 
due  to  scaling. 

on  coomanding  various  bearing  rates,  while  ordering  zero  pitch  or  zero 
depth  rate  to  the  two  compensators.  The  resulting  behavior  of  the  vehicle 
with  respect  to  depth  will  then  provide  a  common  means  of  comparing  the 
re^onse  of  the  two  designs. 

The  first  simulation  run  for  both  controllers  is  for  a  small  ex¬ 
cursion  about  the  ncxidnal  point  of  1  degree/s  and  zero  faet/s  (or  zero 
pitch  for  the  r  -  6  system) ;  it  is  expected  that  the  nonlinear  model 
should  behave  linearly  in  this  vicinity  and  vnould  provide  a  gauge  of 
how  successful  the  model  was  in  meeting  some  of  the  performance  specifi- 

e  e 

cations.  The  entire  state  outputs  for  the  ij'  -  z  compensator  simxilation 

e  e 

are  found  in  Figure  5-2.  The  li*  and  z  consnand  errors  under  the  control 
input  heading  of  Figure  5-2  indicate  the  performance.  It  can  be  seen 
that  settling  times  for  both  outputs  are  indeed  within  50  -  60  seconds 
and  are  in  oonpliance  with  the  perfornuutce  specifications  of  Section  2.6. 
Note  also  that  there  is  already  a  small  error  in  z  after  60  seconds. 

This  error  tends  to  zero  as  more  time  is  allowed  for  the  simulation,  and 
results  in  a  maximum  vehicle  depth  change  of  about  5  feet  for  this  maneuver 
The  command  errors  of  the  r  -  6  cospensator  shown  in  Figure  5-3  exhibit 
neeurly  the  sane  performance  as  the  -  z  compensator  for  the  heading  rate 
orders,  but  the  e  output  state  ejq^riences  a  small  overshoot.  Figure  5-3 
also  shows  that  as  6  approaches  the  value  of  zero  (level  turn) ,  the  vehicle 
depth  continues  to  increase  without  apparent  bounds.  This  is  not  a  sign 
of  instability,  but  rather  an  indication  that  6  is  not  a  very  accurate 
representation  of  depth  rate. 


CONTROL  INPUTS 

NOH'LlMCnn  SintILATION  *-P3l 


Figure  5-3.  Nonlinear  sinulation  ehowlng  ou^ut  error  and 
xeaponae  for  r  -  6  control  aystem  ii^  vicinity 
of  ncdinal  point. 


When  baaring  rates  were  nuch  greater  than  the  noalnal  rata,  tlw 
syaten  behaved  In  a  much  different  fashion.  The  simulation  results  in 
^Figures  5-4  are  for  a  cosnanded  bearing  rate  of  2  degrees/s,  or  about 
double  the  noninal  rate.  Note  here  that  the  time  scale  has  been  e:q>anded 
to  400  seconds.  The  output  error  of  }  takas  t  120  seconds  to  settle, 
ehile  the  t  error  shows  indications  of  sattlii  mie  time  greater  than 

400  seconds.  Figure  5-5  demonstrates  similar  vs  for  the  r  -  6  con¬ 
troller  f  the  6  error  state  has  nearly  the  same  shi^  as  the  z  error  state 
except  for  a  different  sign.  Note  that  the  dynamics  of  z  and  8  are  rather 
complicated  and  osrtainly  not  hanaonic  in  nature.  This  is  no  doubt 
cauaed  by  the  nonlinear  behavior  of  the  submarine. 

Ordinarily,  performance  measures  are  given  in  the  fora  of  settling 
times,  rise  times,  percent  overshoot,  etc.  These  conventional  measures 
cannot  be  applied  exactly  (unaltered)  in  this  case  due  to  the  nonlinear 
behavior  that  wuld  render  such  indices  meaningless  or  misleading.  For 
instance,  a  steady-state  output  error  may  prolong  the  measure  of  system 
settling  time,  although  the  output  error  mey  have  reached  this  particular 
•cate  in  a  relatively  short  tisM. 

Quantitativs  comparisona  will  bo  made,  instaad,  through  perform¬ 
ance  indices  that  are  based  on  an  integral  error  of  the  form 


».I.  -  J  • 


(t)  dt 


for  a  step  input  of  the  cceaiendcd  output,  the  integral  error  becomss 


P.I.  ■ 


^(t)  dt 
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Figiire  5-5. 


Nonlinear  simulation  showing  output  error  and  response 
for  r  -  6  control  system  away  from  nooinal  point. 
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This  is  a  particularly  useful  and  convenient  measure.  As  it  turns 
out,  the  change  in  depth,  or  depth  excursion,  in  a  specified  time,  t^,  of 
a  submersible  that  is  cowsiandsd  to  maintain  a  constant  depth  is  equal  to 
the  depth  rate  integral  error.  Equation  (S-1)  will  not  be  applied  pre¬ 
cisely  to  the  r  -  6  controller}  hcnfever,  the  resulting  depth  excursions 
and  heading  errors  provide  a  comoon  means  to  coiqpare  the  performance  of 
the  two  control  systems.  These  results  are  plotted  in  Figures  5-6  and 
5-7.  Figures  5-6  shows  no  significant  differeiices  between  either  control 
system's  yaw  rate  integral  errors.  Several  conclusions  can  be  drawn  from 
Figure  5-7,  however.  Both  controllers*  performance  is  best  near  the 
nominal  point  bearing  rate  (1  degree/s) ,  although  it  czm  be  seen  that 
the  depth  excursion  of  the  r  -  d  controller  is  greater.  Again,  this  is 
not  surprising  since  6  is  only  a  partial  description  of  the  full  depth 
expression  [(Eq.  (2.14))].  For  an  equal  interval  of  1  degree/a  on  either 
side  of  the  nominal  point,  the  depth  excursions  of  the  tp  -  z  controller 
are  nearly  synoaetrical  with  respect  to  the  nominal  point,  whereas  the 
error  of  the  r  -  d  controller  is  less  at  lower  turning  rates.  In  either 
case,  the  controllers  provide  better  depth  control  than  otherwise  achiev¬ 
able  by  manual  means,  althou^  the  rapid  increase  of  depth  for  commanded 
turning  rates  greater  than  2  degrees/second  or  less  than  0  degree/second 
(opposite  turn)  swy  be  an  Indication  that  the  system  is  ]3ecoming  less  stable. 

It  is  very  unlikely  that  a  submarine  would  stay  in  a  maneuver  li)ce 
this  for  very  long  since  it  would  have  cos^letad  a  full  (360  degee)  turn  in 
about  3  minutes.  A  more  realistic  operating  scenario  was  simulated. 

Figure  5- 8  shows  a  aeries  of  maneuvers  in  response  to  veurlous  reference 
inputs  listed  in  Table  5-1.  Which  are  in  the  form  of  fast  ramps  (1-5 
seconds)  .  This  is  to  simulate  the  commands  an  operator  may  issue  through 
the  "joy-stick"  in  suuieuvering  his  vehicle.  An  interesting  observation 
in  Figure  5-8  is  that  coomanded  changes  in  6  have  very  little  effect  on  r 
as  indicated  by  points  1,  3,  and  4;  however,  the  commanded  change  In  r 
does  have  a  substantial  effect  on  the  error  in  e ,  as  seen  in  point  2. 

Point  5  of  Figure  5-6  shows  the  effect  of  commanding  simultaneous  changes 
in  r  and  6 . 
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COMMANDED  ^  RATE  <dog/t) 


Figure 
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5-6.  Integral  yaw  error  for  commanded 
rate  after  100  seconds. 


Figure  5-7.  Integral  depth  error  for  commanded  \p 
rate  after  100  seconds. 


Table  5-1.  Nonlinear  simulation  r  -  6.  Time  and  the 
corresponding  reference  Inputs. 


Poipf 


(!■ 


TIME 

f 

e 

JSS. 

0.0 

(10  dog/s) 

(deg) 

-.100000E*0< 

0.0000008*00 

40.0 

-.lOOOOOEOZ 

0.0000008*00 

41.0 

-.1000O0E«0t 

0.2000008*01 

100.0 

-.100000E«Ot 

0.8000008*01 

101.0 

O.OOOOOOE*00 

0.2000008*01 

too.o 

O.OOOOOOE^OO 

0.2000008*01 

m.o 

O.OOOOOOE*00 

0.0000008*00 

soo.o 

O.OOOOOOE«00 

0.0000008*00 

sos.o 

0.0000008*00 

0.8000008*01 

S7B.0 

0.0000008*00 

0.8000008*01 

seo.o 

0.0000008*00 

0.8000008*01 

440.0 

0.0000008*00 

0.6000008*01 

445.0 

1800008 

0.2000008*01 

800.0 

-.1800008*02 

0.2000008*01 

The  full  response  of  the  0  -  z  cott^nsator  to  veirious  command  in¬ 
puts  are  shown  In  Appendix  C. 

5.3  Robustness 

To  determine  how  close  the  controller  is  to  being  unstable,  recall 
that  E  (s)  was  given  by 


E  (s) 
-pre 


IG(8)  -  G(s)]  .  G  (8) 


(3-1) 


It  is  cle£u:  that  for  this  simulation  G(s)  cQjove  is  a  function  only  of  the 
system  nonlinearities  since  the  hydrodynamic  coefficients  remain  as  pre¬ 
determined  constants.  The  structure  of  G(s) ,  then,  can  be  found  for  any 

a 

operating  condition.  Note  in  Figure  5-9  that  a  commanded  of  -2  degrees/s 
corresponds  roughly  to  8  degrees  of  rudder.  Since  this  region  of  controller 
operation  appears  to  be  approaching  its  performance  limit,  G(8)  will  be 
determined  by  line2u:ization  of  the  submarine  dynamics  about  8  degrees  of 
rudder . 


System  robustness  will  then  be  studied  through  the  inequality 


„(jw)  ]  1  o 

max  — pre  — 


4  + 

min  — 


(G(jw)  K(jw))"^] 


(3-2) 


Figures  5-10  and  5-11  provide  a  gri^hical  interpretation  of  Eq.  (3-2)  eUxrve. 
In  Isoth  instances  the  maximtan  singular  values  of  (s)  are  equal  to,  or 
slightly  larger  than  the  minimum  singular  values  of  the  inverse  return 
difference  matrix  of  the  loop-transfer  function  for  the  bandwidth  vqp  to 
0.1  radiems/s.  Hence  the  inequality  (3-2)  a}30ve  is  not  satisfied  and 
stability  can  no  longer  be  guaranteed. 


For  the  -  z  conpensator  of  Figure  5-11  a  bulge  forms  in  the 

singular  values  of  E  (s) .  This  is  most  li)cely  due  to  the  presence  of 

«  • 

non-minim\xn  phase  zero  in  the  ^  -  z  system  since  the  difference  between 
^re^°^  of  either  system  can  only  be  attributed  to  the  C  matrix  used  for 
the  ou^uts.  Although  the  maximvim  singular  value  of  E  (s)  is  not  greater 


»-l. 


-pre 


than  the  singulfu:  values  of  (^  +  T  (s) )  near  the  bulge,  it  is  typically 
at  these  higher  frequencies  ar'^  ubove  that  other  modeling  errors  (such  as 
unmodeled  dynamics)  are  li)cely  to  occur  in  an  actual  submarine.  The  combina¬ 
tion  of  the  unmodeled  errors  in  G(s)  and  the  bulge  in  E  (s)  for  the  i  -  z 

—  —pre 

controller  is  more  likely  to  result  in  an  unstedsle  system  than,  say,  rela¬ 
tively  flat  singular  values  of  that  appeeurs  in  Figure  5-10. 


5.4  Gain  Scheduling 

Gain  scheduling  involves  the  use  of  more  than  one  set  of  matched 
Kalman  filter  gain  matrices  (H)  and  control  gain  matrices  (G)  to  provide 
the  compensator  with  the  ability  to  extend  acceptable  performance  emd  ro¬ 
bustness  requirements  over  the  widest  possible  rcuige  of  operating  condi¬ 
tions.  These  operating  conditions  for  the  rate  controller  design  can  be 
expressed  here  in  3-dimenaional  ''volumes".  This  concept  is  shown  if 
Figure  5-12.  The  specification  of  speed,  rudder  deflection,  and  stern 
pl2uie  defection  define  a  single  point.  On  this  diagram,  one  can  plot 
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Figure  5-10.  Inverse  return  difference  of  recovered  tramsfer  function  and 
premultiplicative  error;  r  -  6  system;  singular  values  vs 
frequency. 
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Inverse  return  difference  of  recovered  transfer  function 

•  • 

and  premultiplicative  error;  il/  -  z  system;  singular 
values  vs  frequency. 
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Figure  5.12.  Schematic  showing  operating  volume  for  determination  of  model 
robusl.ieas  and  acceptable  performance  near  a  nominal  point. 
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regions  wtwre,  about  a  naninal  point  (s),  the  multiplicative  error  ceui  be 
determined  and  robustness  checked  in  a  test  similar  to  Eg.  (3-2)  above. 

This  is  called  the  region  of  guaranteed  stedsility.  Another  volume  on  the 
same  plot  is  reserved  for  performance.  It  includes  all  points  about  the 
nominal  point  that:  result  in  acceptable  performance.  The  intersection  of 
the  stability  region  and  the  performance  region  defines  the  outer  bounds  of 
the  operating  range  of  the  particul6ur  set  of  gains.  Many  nominal  points 
together  would  be  required  to  cover  the  full  possible  operating  range  of 
the  submersible. 

Gain  schedviling  can  then  be  accomplished  by  two  possible  approaches: 

(1)  Establish  lairge  overlapping  volumes  around  nominal  points 

where  particular  set  of  gains  (including  corresponding  models 
of  the  A,  and  C  matrices)  are  satisfactory  with  respect 
to  performance  and  robustness.  The  shift  of  gains  from  one 
region  to  anotlier  would  be  through  a  band-bang  implementation. 
This  procedure,  of  course,  requires  implementation  schemes 


that  would  allow  the  gain  shift  to  occur  without  violent 
transients  of  the  control  surfaces. 

(2)  Select  nominal  points  to  3p^u:\  the  volume,  and  schedule  the 

gains  of  the  compensator  through  a  quadratic  or  least  squares 
fit  of  the  operating  conditions  through  the  nominal  points. 
Lively  (14]  has  successfully  implemented  such  a  methodology. 

It  becomes  difficult,  however,  to  evaluate  the  robustness  by 
methods  used  in  this  thesis.  One  must  somehow  ensure  that 
all  quadratically  obtained  gains  result  in  enough  robustness 
to  overcome  the  unmodeled  dynamics. 

5.5  Other  Notes 

When  q,  the  control  gain  weighting  index  is  increased  over  the  value 
of  10  used  in  this  design,  the  gain  entries  of  G,  of  course,  increase.  The 
result  is  that: 


(1)  The  bandwidth  of  T(s)  increases  slowly  to  match  the  crossover 
of  G^. 

(2)  The  control  surface  deflections  for  maneuvers  similar  to  those 
performed  in  this  chapter  increased,  and  tended  toward  satura¬ 
tion  as  q  increased  further. 

(3)  The  maximum  rate  limits  of  the  actviators  were  exceeded. 

(4)  There  was  no  noticeable  increase  in  performance.  Therefore, 
the  value  of  q  was  kept  as  small  as  possible  consistent  with 
meeting  the  minimum  bandwidth  requirements. 

5.6  Chapter  Summary 

The  performzmce  comparisons  of  and  between  the  two  compensator 
designs  aure  far  from  complete.  It  was  the  intent  of  this  chapter  to  show 
how  one  could  begin  to  evaluate  a  design;  a  f\ill  evaluation  of  each  con¬ 
troller  would  require  many  more  calculations  to  be  completed.  One  might 

conclude  at  this  point  that  linearization  required  to  obtain  the  C  matrix 

«  • 

used  in  the  <|)  -  z  controller  has  resulted  in  a  somewhat  less  robust  design. 

•  • 

However,  the  ii  -  z  controller  provides  more  precise  control  of  turning  and 
depth  rates  which  is  the  ultimate  control  objective  of  this  design. 

The  question  of  robustness  away  from  the  nominal  point  chosen  in 
this  design  was  only  partially  ansered.  Nonlinearities  most  likely  pro¬ 
vide  the  greatest  source  of  modeling  errors.  Other  dynamics  that  arise 
from  errors  in  the  hydrodynamic  coefficients  and  urunodeled  dynamics  are 
not  known  at  this  time  but  are  required  in  order  to  complete  the  robustness 
picture  before  a  practical  design  can  be  produced  for  a  real  submersible. 

The  control  gain  matrices  for  both  control  systems  are  found  in 
Appendix  B. 
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CHAPTER  6 


CONCLUSIONS 


6.1  Summary 


Multiple- input  multiple  output  control  system  design  methodologies 
has  been  successfully  employed  to  provide  a  means  for  an  operator  of  a  sub¬ 
mersible  to  control  heading  and  depth  for  complicated  maneuvers.  This 
study  is  far  from  a  completed  design.  However,  results  thus  far  are  en¬ 
couraging.  Of  significemce  this  thesis  has: 

(1)  Provided  one  of  few  available  examples  of  a  complex  LQG/LTR 
Model  Based  Compensator  designs  evaluated  on  a  nonlinear 
simulation. 


<2)  Developed  a  loop-shaping  technique,  using  integrator  aug¬ 
mentation  in  the  command  input  channel,  in  which  singular 
values  cem  be  brought  arbitrarily  close  together  and  then 
recovered  through  natural  scaling  of  the  output  variables. 

(3)  Con5>arec  the  performcince  and  robustness  of  rate  control 

designs  based  on  a  consteuit  C  matrix  (the  r  -  9  controller) 

and  a  lineeurized  C  matrix  (the  ^  ^  z  controller)  .  The  ^  -  z 

• 

controller,  which  directly  controlled  the  leading  rate,  , 
and  the  depth  rate,  z,  provided  better  control  of  the  sub¬ 
marine  depth  in  a  turn  than  the  r  -  0  contro) ler  design. 
Heading  rate  control  was  essentially  equal  in  both  designs. 
However,  the  linearized  C  matrix  of  the  ij;  -  z  design  showed 
potential  for  less  stability  as  the  vehicle  states  deviated 
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from  the  nominal  point.  The  non-minimum  phase  zero  of  the 
^  -  z  controller  was  outside  the  desired  bandwidth  and  did 
not  effect  the  loop-transfer  recovery  process. 

6.2  Recommendations 

Much  more  work  can  be  done  to  further  provide  practical  uses  of 
the  MIMO  LQG-LTR  methods  used  in  this  thesis  amd  to  take  a  deeper  look 
into  achievcible  submarine  performance  through  rate  control  systems.  Some 
topics  not  thoroughly  covered  in  this  thesis  that  could  provide  a  basis 
for  further  research  include: 

(1)  A  demonstration  of  stcibility  and  perfoimeuice  as  a  function  of 
state  variable  scaling  to  see  if  the  natural  scaling  pro¬ 
cedures  developed  in  this  thesis  effect  the  actual  performance 
bandwidth  over  unsealed  state  varicdsles  or  designs  with  differ¬ 
ent  scaling  methods. 

(2)  Determining  an  error  norm  that  combines  both  the  known  errors 
due  to  the  model  deviations  from  linearity  as  well  as  errors 
that  estimate  the  tolerances  of  the  hydrodynamic  coefficients 
and  other  modeling  errors  in  order  to  provide  a  better  picture 
of  the  achievable  compensator  robustness. 

(3)  Checking  the  performance  of  the  model  in  response  to  environ¬ 
mental  noise. 

(4j  Developing  a  practical  method  of  gain  scheduling  so  the  con¬ 
troller  provides  good  performance  in  all  attitudes  auid  speeds. 

(5)  Determining  how  scheduling  the  sail  planes  (the  k  factor  in 
Eq.  (2-11))  effects  the  performance  and  stebility  of  the  sub¬ 
marine. 

(6)  Applying  the  design  procedure  used  in  this  thesis  to  develop 
control  systems  for  different  fin  configurations,  to  possibly 
include  "Y"  and  "X"  sterns,  and  differential  control  of  a 
cruciform  stern. 
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Table  A-1.  Dynamical  response  terms  (Abkowitz) . 


1.  Body  Prefer ties 

Length 

Geometry 

Mass 

Maoents  of  Inertia 


2.  Properties  of  Motion 
Orientation 

X  ,  y  ,  z  fixed  coordinate  system,  reference  at  surface 

o  o  o 

(p ,  6 ,  4)  angular  rotations  about  the  x,  y,  and  z  cixis, 

respectively 

Body  Motion 


U  linear  velocity  vector 

n  angulax  velocity 

e 

U  linear  acceleration  vector 

4. 

Q  angular  acceleration 

6  control  surface  deflection 

• 

6  control  surface  velocity 

•  e 

6  control  surface  acceleration 

n  propeller  emgular  velocity 

n  propeller  amgular  acceleration 


3 .  Fluid  Properties 

p  mass  density  of  fluid 

p  viscosity 

T  surface  tension 


g  acceleration  of  fluid 

p  pressure  of  fluid 

p^  vapor  pressure  of  fluid 

E  elasticity  of  fluid 
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which  are  teJcen  to  be  Taylor  expansion  coefficients. 

Moments  of  inertia  are  written  in  similar  form*  but  all  subscripts 
following  retain  the  usual  meaning  of  coordinate  system. 
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A.  3  Parametric  Linearization 
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Pitching  Torque 


124 


Pitching  Torque  (Conti ) 


♦  Aw[u  { 


0^/  2  2  2x3/2 

'  0  0  0' 


2  2 

(m _ +  M  r*;  M  +  M  v  o^  +  n  ♦  K 

^  pp*^0  rr  0  vr  0  0  vp  <r0  rp2  0*^0 


♦  **11  •*■  “I  I  -rA"  ♦  (n.  -  DM  }  + 

w  |w|  ^  0  wnJ 


/2  2 

0  0 


{Ml  I  q.  +  M  I  - - - i-  -►  M  -  - p-i-  + 

|w|q  0  w|w  wv 


+  (n„  -  DM, 


i  *  ''o) 


0  «  w  h  *», 


0  ^  ''O^i  .  ®”CRFM  *1 

J  *  “g'^o  *  — 5;7-  J 


* -1*^1 
0  0  0 


—  (2M _ p-  *  M _ v„  M  .r.)  +  ■ac^v. 

—  PP^O  vp  0  rp2  0  GO 


-  2p«I  -  q«l  ♦  (I  -  I  +  M  )r„] 
^0  zx  zy  z  X  rp  O^ 


^  Aq[ug(M^  -  ^  (n^  -  DM^  ^  H,  1^,  ^  6.^)  > 


+  V-Mi  I  /I  ♦  —  -  BZ.w.  -  I  p.  +  2M  I  I  q.  + 

0  ,J  =0  ,x>'0  ,|,|l’ol 


3M  * 

CRPW  1 

♦  I  >f/X  +  ~~i -  J 

xy  0  3q  J 


(M  V-  ♦  M  ,p„  +  2M  r. )  +  iiiz_v  •* 
vr  0  rp2  0  rr  0  GO 


J  2  2  2 

■*■  '"o  ■*■  '^0 


3M_„  * 

+  -  I  +  H  )  +  I_.q-  •»•  2I__r.  ♦  — IT- —  ] 


V.  Pitching  Tbrqua  (Cent.) 

♦  Af  [-(Xjnen  -  XgB)  CO.  8p  .in  + 

+  M  [  ixjl  -  Xg8)  .In  CO.  -  (*  WTOT  -  x 

1 


,B 


Wh.r«i 


dM 


^''an“o‘lo  ♦  +  M 


qn  0^0  *  "wn"o*o  ■*■  "w|wji,’'o'^'^0  *  * 


CRPM 

3v 


*■  H,  u!:5.  1 

Ann  0  Q> 


«  —  r  1  ^  w  ^  f 
2  /,D(x)  dx^  1 


D(x)  <*q(«)  y^(x) 


dx 


3M. 


OtfW 

3T” 


-  e.  r.2  ^wv  ^  ,  (v«(X)  4>  2w?(x)'| 

2  TToUn?)  /*  «  D(x)  --2 -  0  I 


dx 


=»«CR«  • 

3q 


-  ^  f-i^  (  2  ♦  2w^x)) 

2  ^  ‘  TroursrJ  /f  *  D(x)  — ° - 2 — i 

■■’■ 


+  wj(x) 


3H 


CRPW 

3r~ 


-  £.fi2 


S.  ft*  wv  ^,  9 

2  ^  Tjori)  Jji  *  D<’‘> 


%(X)  V„(x) 


0 . 0 

/vf(x)  •►  --^ 


dx 


(X) 


cos  6,1  ♦• 


126 


VI.  xawing  Torqu*. 


-■y^u  *  (wt-  -  M.)av  -  ♦  Bi)^?  -  I  Aq  +  (I  -  H.)Ar 

u  Q  ▼  Z3L  p  ys  z  r 


-  Att[2Uj,(B*  ♦  +  (ng  -  1)B^  )ArQ}  + 

rn 


2  2 


'■0  0  0-' 


+  Vo  *  -  “g  ^  “|r|6r  ^  *  ‘^0  ' 


w  (w^  ♦  u^) 

+  Av[u  {n  +  N  — --2 — 2 - ^  ■  ■  ■  +  {n_  -  DB  } 

L  ol  V  vw,2  2^  2^3/2  0  VT,  ^ 

'0  0  O'' 


-♦•  — — —  {Ml  I  -♦•  2M  I  iv^  •f  2(n.  -  DM  i 

rj—y  ‘  rr  °  "rl  °  °  H' 


/v):  *  w!: 
0  0 


/  2  2 

»  V-  V 

0  0 


{m  1  iw.  ♦  (n„  -  1 )N 

'■  V  V  0  ‘  '0  V 


|»|n'ol  *• 


3M  • 

vq'O  0  3v  ■' 

r  2  2t 

V„[U-  •♦•  V„J  v„ 

.  r  „  0''  0  O'  0 

Aw  U-H  -  - - -  + - — - 

0  w  /  2  2  2.,  3/2  — = - - 

^0  0  O'  /V  +  w 


*  I  !''«+ 
V  V  0 


^'’o  ’  ’’MvIn'^oJ  ^ 


♦  r-(M  ■» 
0''  vrr 


N|  I  w„ 
V  r  0 


*  "“gPo  *  "'wpPo  ^  “^g'^O  *  9 


21 


Yawing  Torqua  (Cont. ) 


+  ApfH  u_  +  w^(ant_  +  M  )  +  +  q^. 

p  0  0  G  wp  ^0  xy  ’0 

pq  X  y  G  pq'  yi  qJ 

*  Mt’vq’o  *  •'o'o  *  “p,  *  -  'y’fo 

-  “w’o  ’  'o(  V  -  *..)  *  *1  * 

•  *t(«„(ll^  -  «r„  *  (n„  -  1)»^}  » 


f  On 

+  W  f»|  I  1  +  — -  _  *y  1  +  U  w  *  1  p 

O'*  V  r  _2  ^G-'  wr  0  yz*^C 


an  I* 

♦W^.'  "“rlrll'ol  *-W^\  1 


♦  [ (z^WTOT  *  XgB)  coa  cos  9^]  + 

♦  Ae  (y^WOT  -  y^B)  cos  6^  -  (x^W  -  x^B)  aln  9^  >ln  9^^] 


wharai 


>  A«r  [(H^^  ♦  -  i>>uj  ♦  "l^la^UolrJ]  ♦ 


♦  An  [s _ u-r.  ♦  N  u-W-  4-  N  I  I  v./vf  ♦  w^  +  N.  u^Jr^l 

I  m  0  0  vTj  0  0  V  V  n  o  o  o  Arn  0  oJ 


3W_„  * 

CRIW 


(w  (x)  *  2v^(x)) 


Vq(x)  + 


2  rD(7)  dx)  /t 


/vf(x)  +  w^(x) 


Teible  B-1.  Nominal  design  point 


Uq  (FT/SEC) 
47.380 

Pq  (RAD/SEC) 
-.00003 

^*0  (DES) 

-  .7350 

(DEG) 

-9 .4520 

RPS 

2.369 


Vq  <  FT/SEC)  w, 

2.270  0 

qo  (RAD/SEC)  r 

0.00305 

5bo  (DEG)  £ 

O.OOCO  2 


THETAq  (DEG) 
-0.08156 


,  (FT/SEC) 

,  531  9 

,  (RAD/SEC) 
.01829 

r Q  i DEG ) 

.  0000 


Table  B-2.  Augotented  linecur  system  (A,  B  matrices). 
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Table  B-4.  i  -  z  compensator  matrices. 


Wonlinaar  Simulation  of  i 
VariouB  Conaanded  Inputs 


insator  for 


(The  ainulatlon  in  this  appendix  is  based  on  the  following  table 
of  coomand  inputs  for  heading  rate,  in  tinits  of  "tens"  of  degrees,  euid 
depth  rate,  in  units  of  0.01  *  feet/s). 


T  ima 

PS 1 DOT 

I  DOT 

0. 

-10.000 

0.0 

60. 

-10.000 

0.0 

65. 

-15.000 

0.0 

1  20  . 

-15.000 

0 . 0 

1  25. 

-1 J.OOO 

0.05 

1  80. 

-15.000 

0.05 

1  85  . 

0.000 

0 . 0 

240. 

0.000 

0 . 0 

245. 

-5.000 

0 . 0 

290. 

-5.000 

0 . 0 

295. 

-5.000 

-.  1 

350. 

-5.000 

-  .  1 

355. 

-10.000 

0.0 

440. 

-10.000 

0.0 

445  . 

-15.000 

-.  1 

600. 

-15.000 

-.1 
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